//
// Created by geoffrey on 24-11-16.
//

#ifndef DRAWTRAJECTORY_H
#define DRAWTRAJECTORY_H

#include <pangolin/pangolin.h>
#include <Eigen/Core>
#include "DrawTrajectory.h"
#include "UUV.h"
#include "Eular2Isometry.h"
#include <Eigen/Geometry>
#include <unistd.h>
#include <thread>
#include <chrono>
#include <unistd.h>
#include "MatlabEngine.hpp"
#include "MatlabDataArray.hpp"
// 画出轨迹
using namespace std;
using namespace Eigen;

void DrawTrajectory(const vector<Matrix<double, 6, 2>,aligned_allocator<Matrix<double, 6, 2>>>& State ,const vector<Matrix<double, 6, 2>,aligned_allocator<Matrix<double, 6, 2>>>& State_d) ;
#endif //DRAWTRAJECTORY_H
